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► Robot kinematics: 


► Description of motion of the robot without consideration of the forces and torques 
causing the motion. 


► The Kinematics is a geometric description. 



Kinematics 



Forward 

Kinematics 




Inverse 

Kinematics 




CCE4242- Robotics 


3 

Forward and Inverse Kinematics 



► Forward Kinematics 

► Determination of the (actual) position and orientation of the end-effector given the values 
for the joint variables of the robot 

► Inverse Kinematics 

► Determination of the values of the joint variables of the robot given the (desired) position 
and orientation of the end-effector 

► Notes 

► Inverse Kinematics is required to determine the control action 

► Forward kinematics is required to give feedback about end-effector pose 
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MANIPULATORS 
FORWARD KINEMATICS 


Robot Manipulators 
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► A robot manipulator is composed of a set of links connected together by joints. 

► A robot manipulator with n joints will have n + 1 links as each joint connects two links. 
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Robot Manipulators 


► Convention 

► We number the joints from 1 to n , and we number the links from 0 to n , starting from the 
base. 

► By this convention, joint i connects link i - 1 to link i. We will consider the location of joint 
i to be fixed with respect to link i - 1. 

► When joint i is actuated, link i moves. 

► With i th joint we associate a joint variable, denoted by q t 

► Angle of rotation in case of revolute joint 

► Joint displacement in case of prismatic joint 
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Kinematics Analysis 


► To perform the kinematic analysis, we attach a coordinate frame rigidly to each link. 
In particular, we attach frame o^y^to link i. 

► The frame o 0 x 0 yoZo, which is attached to the robot base, is referred to as the inertial 
frame. 
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Kinematic Analysis 
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► Suppose A t is the homogeneous transformation matrix that expresses the position 
and orientation of o^y^ with respect to o £ _ 1 x £ _ 1 yi_ 1 z £ _ :L 

► Ai is a function of only a single joint variable, namely q t . 

Ai — Ai(qi) 

► The homogeneous transformation matrix that expresses the position and orientation 
of frame OjXjyjZj with respect to frame o £ x £ y £ z £ is denoted by: 



if i<3 
if i = J 
if 3 < i 
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End-Effector Pose 
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► The position and orientation of the end-effector with respect to the inertial frame 
are denoted by a vector 0 ° (represents the coordinates of the origin of the end- 
effector frame with respect to the base frame)and a rotation matrix R% respectively. 

► The homogeneous transformation matrix of end-effector pose H is: 


H = 
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Pose components 
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► For homogeneous transformation matrix T- 


T; — Ai + iAi + 2 Ai — 


v 


Rj 0) 
0 1 


j > i 


pi — pi pi+1 
K j ~ K i+l K i+2 


r j 


j - i 


°j 


oj-t + Rj-iOj- 1 


CCE4242- Robotics 


Review Example 



► Consider the two-link planer manipulator 
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DH ASSUMPTIONS 
ASSIGNING FRAMES 



Denavit-Hartenberg convention 
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► Denavit-Hartenberg convention or DH convention is a commonly used method for 
selecting reference frames of robots 

► In DH convention, the 6 parameters associated with an arbitrary homogeneous 
transformation are reduced to 4 by appropriate selection of reference frames 

► In this convention, each homogeneous transformation A t is represented as a 
product of four basic transformations using the following parameters: 

► a{. Link length 

► a t : Link twist 

► d t : Link offset 

► 6 t : joint angle 
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DH-Assumptions 
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► DH coordinate frame assumptions 

► DH 1 - The axis x t is perpendicular to the axis z i _ 1 

► DH2- The axis x t intersects the axis z t _ ± 

► Under the above assumptions A t is achieved by 

1. Rot(z,di ) 

2. Trans(z,di) 

3. Trans(x,a i ) 

4. Rot(x,ai) 

► At = Rot(z, 6i ) * Trans(z, d{) * Trans(x, a{) * Rot(x, a t ) 
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DH-Assumptions 
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DH-Parameters 
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The parameter a is the distance between the axes z 0 and z x measured along the 
axis x ± 

► The parameter a is the angle between the axes z 0 and z lt measured in a plane 
normal to x ± axis 

► The parameter d is the perpendicular distance from the origin O 0 to the intersection 
of the x ± axis with z 0 axis measured along the z 0 axis 

► The parameter 6 is the angle between x 0 axis and x t axis measured in a plane 
normal to z 0 axis 

► Hint: 

► d : is, only, the variable in case of prismatic joints 

► 6 : is, only, the variable in case of revolute joints 
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Coordinate Frames Assignment 
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Assign z t to be axis of actuation of joint i + 1 

2. Establish arbitrarily the base frame: x 0 ,y 0 , (z 0 determined in step 1) 

3. Define x t based on one of three cases 

a. The axes z i _ 1 and z t intersects 

b. The axes z t _ ± and z t are parallel 

c. The axes z i _ 1 and z t are not coplanar 

4. Define y t in the appropriate direction to complete the frame 

5. The final coordinate frame o n x n y n z n is commonly referred to as the end-effector or 
tool frame. The origin 0 n is most often placed symmetrically between the fingers of 
the gripper 
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Assignment of x t axis 
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z t _ t and z t are intersected 

Xj is chosen normal to the 
plane formed by z i _ 1 and z L . 

The positive direction of x t is 
arbitrary. 

The most natural choice of o t 
to be at the intersection point 
of z i _ 1 and Zj 

In this case a t equal zero 


Zi_! and z t are parallel 

There are infinitely common 
normal between them 

DH1 doesn’t specify Xj 
completely 

It’s free to choose o t anywhere 
along z t 

The normal going through o t is 
chosen to be x t 


Zi_ ± and z t not coplanar 

There exists a unique shortest 
line segment from z i _ 1 to z it 
perpendicular to both of them 

This line segment defines x t 

The point where the line of x t 
intersects z L is the origin o t 
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PLANAR MANIPULATOR 
CYLINDRICAL ROBOT 



DH-solution steps 
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► Assignment of coordinate frames according to the defined rules 

► Construction of DH-Table containing the parameters of each 
transformation matrix between two successive links 

► Compute the transformation matrix A t for each link 

► Compute the whole homogenous transformation matrix T° 

► Remember: 

► A t = Rot(z, 6i) * Trans(z, d t ) * Trans{x, * Rot{x, a{) 

► H = T°=A 1 (q 1 ) A n (q n ) 
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Two-Link Planar Manipulator 
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Link parameters for 2- Link planar manipulator 
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Two-Link Planar Manipulator 


23 





Cl 

-si 

0 

aici 

Si 

ci 

0 

aisi 

0 

0 

1 

0 

0 

0 

0 

1 

C2 

-S3 

0 

«2C2 

S2 

C2 

0 

0>2S2 

0 

0 

1 

0 

0 

0 

0 

1 


The T -matrices are thus given 

I? = A! 
r 2 ° = A\Ai = 


C12 -512 0 

512 C 12 0 d\S\ &2S\2 
0 0 1 0 

0 0 0 1 


CCE4242- Robotics 


Three-Link Cylindrical Robot 
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Link parameters for 3-Iink cylindrical manipulator 
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Three-Link Cylindrical Robot 
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